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l HW 

'no 

l SN 

l WE 
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perpendicular distance between Z^_.j and Z^ 
elbow of robot arm 
hand of robot arm 

integer used in figure 5 to cause Qo = 0^ 
integration step size 

integer to indicate different axis systems and associated parameters, 

i 1,2, • * • , 6 

Jacobian matrix relating waist, shoulder, and elbow joint rates to transla- 
tional velocity commands (in base coordinates) to robot hand 

proportionality constant in equation (7) 

integer 

transformation matrix from hand axis system to base axis system 
row and column of L 

perpendicular distance of wrist from line of rotation of waist joint 

length from elbow to shoulder 

length from hand to wrist 

length from neck to base 

length from shoulder to neck 

length from wrist to elbow 

length from wrist to shoulder; changes as elbow bends 
maximum absolute value of 0^ 
neck of robot arm 
base of robot arm 

projection of wrist position onto 

rotational transformation matrix from coordinate system i to i - 1 
distance between coordinate systems i - 1 and i along Z^ 1 
shoulder of robot arm 
time 
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translational velocity vector 


V T ,V p ,V R linear velocity component in direction of thrust, pitch, or rotation, 
respectively 

V XO' V YO' V ZO components of translational velocity vector in base axis system 

V X2' V Y2' V Z2 components of translational velocity vector in axis system X 2' Y 2'^2 

V X 6 /V Y 6 ' V Z 6 components of translational velocity vector of robot hand in hand axis 

system 

W wrist of robot arm 


Xq,Yq,Zq base axis system 
X 6 ,Y 6 ,Zg robot hand axis system 

cx^ angle between Z^_<| and Z^, measured positively about positive X^ 

6 i • minimum value for 60 

mm j 

63,623 specified positive constant in equations ( 8 ) and (28), respectively 

0 ^ joint angle with initial value corresponding to initial position of robot 

arm in figure 1 

0 joint angle between ^ and X^, measured positively counterclockwise 

1 about 

0 .(k) value of 0 - at time kh 

i 1 

©3 particular value of 63 

0 * last 0 3 in resolved- rate branch of computer program prior to entering 

^ singular elbow region of robot arm (fig, 5) 

p angle to indicate pitching motion (fig. 4) 

o angle which is coordinated with 83 to extend and retract robot arm along 

a straight line (fig. 4) 


a>X6/ &>Y6' W Z6 


rotational velocity components of robot hand, expressed in hand axis 
system (X 6 ,Y 6 ,Z 6 ) 


Subscripts: 


base axis system 


hand axis system 


A dot over a symbol indicates the first derivative with respect to time, 
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INTRODUCTION 


A robot arm should obey movement commands from an operator or computer program 
as closely as possible. Singularities in the mathematical equations that translate 
these commands into arm movements hinder this objective. One solution is simply to 
avoid the singular position of the robot arm that causes a singularity (refs. 1 
and 2). However, in using resolved-rate equations (ref. 3), an operator generally 
issues commands to the robot hand, and to move the hand as commanded, the arm may 
inadvertently pass through a singularity. Erratic motion may result until the arm 
moves sufficiently far from the singularity. A better solution appears to be the use 
of a different set of equations at or near singularities (ref. 4). Of course, the 
transition from one set of equations to the other should produce the overall motion 
that an operator wants. 

This paper discusses the kinematic equations of motion for a six-degree-of- 
freedom manipulator with which the hand is positioned (translated) by three rota- 
tional joints (waist, shoulder, and elbow) and oriented by three additional rota- 
tional joints (wrist). When the elbow joint angle is zero, the robot arm is fully 
extended (straightened) and the regular resolved-rate equations (refs. 4 and 5, for 
example) become singular (division by zero). This paper presents equations which can 
be used, instead of the regular resolved-rate equations, to translate the robot hand 
in the neighborhood of the singularity. These equations are demonstrated in a kine- 
matic simulation of a robot arm with the same geometric parameters assumed in refer- 
ence 4. As the robot arm is being fully extended to the singular elbow position, 
motions (joint angles and joint angle rates) are compared for these equations and the 
regular resolved-rate equations. Finally, two integration methods (Euler and Adams - 
Bashforth second-order predictor integration methods) are compared for three integra- 
tion step sizes. 


ANALYSIS 

A robot arm and its joint axis systems are illustrated in figure 1. Similar 
arms are used in manufacturing by moving the arm through a sequence of prerecorded 
joint angles. Another method of control is teleoperation, where an operator can 
command either joint angle rates or translation rates and rotation rates with respect 
to some axis system, and then a computer resolves the commands into appropriate joint 
angle rates ( 0^ , i = 1 , 2, • . . , 6) . A simplifying assumption is that wrist rotation 
does not translate the robot hand axis system. 

Operator translational velocity commands in the hand axis system are tranformed 
to the base axis system by 


( 1 ) 



where L is a transformation matrix (appendix A) 
joint rates then satisfy the equation 


The waist, shoulder, and elbow 
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where is an appropriate Jacobian matrix (appendix A) . 

The inverse of equation ( 2 ) is 
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provided the inverse matrix 1 exists. Equation ( 3 ) is the translational part of 
the resolved-rate equations that gives the joint rates necessary to move the robot 
hand axis system as commanded by an operator. 

The determinant of J 1 is (appendix A) 

det (J^ ) = (sin 0 ^ + sin( + Q^)]s±n 0^ (4) 

Singularities occur whenever this determinant is zero. Since i ES f 0 , the singular 
conditions are: 


sin 0^=0 


(5) 


sin 0 2 + sin(0 2 + 0 3 ) = 0 (6) 

In equation ( 5 ), 63 = 0 °, which means that the robot arm is at its maximum 
extension. ( ©3 = ± 180 ° is not achievable with the robot arm in fig. 1 . See table I 
for geometric parameters of the robot arm.) Equation (6) means that the robot wrist 
is at its minimum distance ( 1^) from the line of rotation of the waist joint. 

Analysis and simulation were conducted to develop techniques to maintain 
resolved-rate control in the vicinity of (or at) the singularity. Subsequent sec- 
tions describe the method that was developed. The equations presented are used in 
the vicinity of the singularity and allow continued translation control. Outside of 
the singular region the regular resolved-rate equations (appendix A) are applicable. 
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Robot Arm Movement To Handle Elbow Joint Singularity 

The singular position of the robot arm is illustrated in figure 2(a). To 
retract the robot hand, the elbow ( 63 ) must bend either positively (fig. 2 (b)) or 
negatively. Simultaneously, the shoulder joint (0 3 ) moves in the opposite direction 
to keep the robot hand moving along the dashed straight line passing through the 
shoulder and wrist of the robot arm (points S and W in figs. 1 and 2). 

V T , Vp, and V R rates.- The operator's translational control inputs are 
resolved into the velocity components shown in figure 2(b). The velocity component 
V,p lies along the dashed line from the shoulder to the wrist; V p is perpendicular 
to the dashed line and, with respect to figure 1, is parallel to Y 2 ; V R is 
parallel to Z 2 in figure 1 and completes a right-hand coordinate system with V,p 
and Vp. Movement of the robot arm is based on these rates. The arm pitches ( in 

proportion to V p , rotates (0^) in proportion to V R , and extends (0 ) in proportion 

to V T . An additional function of the shoulder joint (0 2 ) is to null any movement of 

the robot hand off the dashed line which is caused by retraction or extension (0 ). 

Expressions for V T , V p , and V R are in appendix B. 

Elbow joint angle rate 63 *“ The table inset in figure 3 indicates the direction 
. — * 

of 0 3 for the different signs on 0 3 and V T . For example, if 0 3 is positive 
and V T is positive, then 0 3 must be negative to move the robot hand outward. 
Notice that the sign of 0 3 is opposite to the product of V,p and the sign of 
0 3 . The joint angle rate is made proportional to V T as 


h = _K 3 V T sgn 9 3 (7) 

where K 3 is a specified constant, which is assumed to be unity in this paper. 

A region about the elbow joint singularity is defined as 


1 0,1 < 


(8) 


where 6 3 is an assigned constant. Whenever the condition in equation ( 8 ) is 
detected, equation (7) is applied until the sign of 0 3 changes, which means 0 3 
passes through 0° and is approximately 0°. The arm holds this extension (but is 
still free to move in pitch and yaw) until a negative V^, is commanded to retract 

the arm. This is better explained later in a flow diagram for the translational 
equations • 

If the maximum absolute value of 0^ is M and if the integration step size 
is h, then 6 3 in equation ( 8 ) should exceed 
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Thus, for h = 1/32 sec and M = 0.5 rad/sec, 6 min = 0.895° or 0.0156 rad. For 
test applications in this paper, 63 was chosen as 1 °. 

Shoulder joint angle rate 0 9 .- The joint angle rate 8 is the sum of two 

2 

• • • • 
other rates: cr and p. The a component coordinates with 0^ to keep the robot 

hand on the dashed line in figure 4. The component p accounts for a pitching com- 
mand from an operator. 

First, consider the rate a. By the law of cosines 


ws 


= V 


ES 


+ l + 2i i 
WE ES VE 


cos 9 , 


( 10 ) 


where x ws is the distance between the wrist and shoulder (points W and S in 
fig. 1). Differentiating equation (10), 


l ws \is 


” -'ES'wE‘ Sin 


83)63 


(ll) 


By the law of sines. 


sin a 


-'we sin °3 


WS 


(12) 


By the law of cosines. 
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Differentiate equation (12) to obtain 
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With equations (11) and (13) , equation (14) is 


a - 


2l WE l ES 


2 2 
l ES + l WS 


- I 


WE 


cos 0 3 + 


l ES l WE Sln20 3 


ws 


(15) 


Second, consider the rate p to pitch the robot arm in response to an 

operator* s command. The robot wrist has a moment arm i relative to the shoulder 

WS 

of the robot arm. Hence, the linear pitching rate V p is the product of this moment 
arm and the angular pitch rate p so that 


P = 


i 


ws 


where 


l WS |/ l ES + l WE + 2l ES l WE C ° S 0 3 (16) 

In this paper, i = i , and the pertinent equations to compute the shoulder 
• £b WE 

joint angle rate 0^ are as follows: 

. - 0 3 

o = — j- (17) 

l WS = l ES / 2(1 + C ° S 0 3 T (18) 



S 2 = a + p (20) 
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Waist joint angle rate 0^ The component of the commanded translational 
velocity in the direction of Z 2 in figure 1 is (from eqs . (B 6 ) and (B7)) 


V 

R 


" Sin 6 1 V X0 + COS 9 1 V Y0 


( 21 ) 


If the robot wrist (point W in fig. 1) projects onto the negative X^-axis, a posi- 
tive waist rotation (0^) is needed to cause a positive linear rate V R along Z 2 - 
But, if the wrist projects onto the positive X-axis, a negative 0 rotation is 
needed for a positive linear rate V R along Z 2 . The projection of the robot wrist 
position onto the X-j-axis is 


P = -sin( 0 2 + 0 3 ) 


WE 


sin 0 2 


ES 


( 22 ) 


Therefore, 



P 


(23) 


translates the robot wrist located at a distance (fig. 4 ) 


l = 



2 

+ P 


(24) 


from the line of rotation of the waist joint with a linear rate V R . The case of 
l WE = l ES an< ^ p = 0 (that is, at the singularity sin 0 2 + sin(0 2 + 0^) = 0 
(eq. (4))) is considered later. 

Logic flow for translational equations .- The logical flow for computing the 

• • • 

joint angle rates 0^ , 0 2 , and 0^ is shown in figure 5. In the block diagram, an 

operator issues translational velocity commands to the robot hand. These commands 
are then transformed from the robot hand axis system (Xg,Yg,Zg) to the base axis sys- 
tem (Xq,Yq,Zq). If 0 2 does not fall within the singular region ( | 83 | < 63), the 
regular resolved-rate equations are used and 0 ^ is equated to 0 3 for later use. 
The resolved-rate equations yield joint angle rates which are integrated to get joint 
angles to drive the robot arm. The operator observes the resulting motion and issues 
new commands. 

If 0 2 does fall within the singular region, the equations indicated in the 
dashed box (fig. 5) are used. As an example, suppose the robot arm is initially in 
position 1 in figure 6 and, in the next time increment, moves to position 2 where ©3 
is within the singular region. On the first pass through the dashed box, 0^ is 
positive (since 0 3 was positive at position 1 ) and the current 0 2 at position 2 
is positive, so their product is positive. Thus, 0 3 is computed with equation (7) 
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and, for positive V T , is* negative. When 0^ becomes negative in the singular 
region, the product of 0^ and the current 0^ is negative. Therefore, for posi- 
tive V T , no further change in 83 is allowed (§3 = 0). However, suppose a 
negative V T is commanded. Since ©3 is now negative and V T is negative, §3 
is negative (table in fig, 3) , and the robot arm retracts by bending the elbow joint 
in a direction opposite to that with which it entered the singular region. If an 
elbow bend does not suit an operator, he simply straightens ( 0 3 = 0 °) and retracts 
the robot arm again. 

If the elbow of a robot arm is bent down (position 2 in fig. 6 ) and an operator 
commands negative V T to retract the robot arm before it straightens, then the arm 
will maintain a downward bent elbow as it retracts. 

In this study, an Adams-Bashforth second-order predictor integration method 

0. (k+ 1 ) =-£[30. (k) - 0 . (k- 1 ) 1 + 0. (k) (25) 

1 2 L 1 1 J 1 


is used with a nominal value of h = 1/32 sec to integrate the joint angle rates to 

get the joint angles. When 0o falls into the singular region, and the arm is fully 

• ^ 

extended with V,^ >0, 63 = 0 in figure 5. In figure 5, ^3 p 1S then used to 
hold the current value of 0 3 ; this is required because equation (25) would compute a 
new © 3 , different from the current value, since the equation contains both present 
and past values of 0 3 . If Euler integration 

e ± (lc +1 ) = h 0 i (k) + 0 i (k) (26) 

is used, 03 ^ would not be required since only the current value of §3 appears in 
equation (26). 

Pitching robot arm at full extension .- For discussion purposes, let the robot 
hand in figure 7 be oriented the same as that in figure 1 . Then if an operator com- 
mands a pitch down with V x g, the arm will pitch down according to equation (19). 
However, in this paper, the robot arm stops when 63 changes sign so that ©3 is 
not exactly zero. Hence, in figure 7(b), when the operator attempts to pitch the arm 
down, there is a negative V T , which causes the arm to retract as it pitches down. 
Pitching the arm up would not cause any retraction because the V T rate would be 
positive. Since the arm is in the stopped extended position and V T > 0, the arm 
will not retract. 

To have the robot arm maintain its full extension (whether pitching up or down) 
until specifically commanded by an operator to retract, simply replace V T > 0 in 
figure 5 with V z g > 0. The arm will then only retract from the stopped extended 
position if the operator commands a negative V z6 . 
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Robot Arm Movement To Handle Wrist-Waist Singularity 

With variations in 0-j (fig. 1), the robot hand generates a circle about Zq. 
Equation (6), or equivalently, 


e 3 = -20 2 (27) 

means that the minimum radius for this circular motion has been reached (fig. 8) and 
the resolved-rate equations are singular. 

In this paper, when 


I sin 0 2 + sin(0 2 + 0 3 )| < S 23 


(28) 


where S 23 is chosen as 0.001 to prevent erratic motions at the singularity, equa- 
tions (7), (20), and (23) are used. In equation (23), l = i gN f 0 for the wrist- 

waist singularity. 


Robot Arm Movement in Cylindrical-Type Coordinates 

Thus far, the operator’s translational velocity command to the robot hand has 
been V gf which is then resolved into joint angle rates in the robot arm. In the 
singular elbow region, is resolved in directions of thrust, pitch, and rotate in 

figure 4 to obtain the rates V T , V p , and V R , which are then used to move the robot 
arm according to equations (7), (20), and (23). As an alternate means of control, 
the operator can be given the option of directly specifying V T , v p , and V R with 
his controller inputs. This mode does not constitute movement in true cylindrical 
coordinates because of the shoulder offset i from the waist station (fig. 4) . 

Inside the singular region ( | 0 3 | < 6 3 ), 0 3 can be made proportional to V T 
(eq. (7)); however, outside the singular region ( | 0 3 | > S 3 ), the robot hand should 

extend and retract along i ws in figure 4 with the actual commanded V T rate. The 
appropriate equation for 0^ follows immediately from equation (11) with the 
substitution 


WS 



(29) 


as 


*WS V T 

l ES l WE Sin 9 


(30) 
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Notice that the sign of 0- is consistent with the table in figure 3; that is, 

, , ^ • 
when V T is positive and 0 ^ is negative, 0 ^ is positive. 

RESULTS AND DISCUSSION 

The kinematic equations for translation control, including the equations to be 
used in the singularity region, were programmed on a CDC® CYBER 175 computer operat- 
ing in real time, interfaced to an ADAGE GPS/340 graphics system, and the manned con- 
trol station in the Intelligent Systems Research Laboratory (ref. 6 ). 

To command translational movements of the robot hand, an operator used a three- 
axis hand controller: one degree of freedom for each of the robot hand speeds V X 6 ' 

Vyg, and V 26 # For exam P l e r i- n figure 1, the robot hand axis system is (Xg,Yg,Zg), 
and the operator commanded the hand to move in the Xg-direction by moving the con- 
troller in the direction corresponding to V x g. 

Based on kinematic equations, a graphically simulated robot arm was driven in 
response to an opera tor* s velocity inputs to the robot hand. The operator observed 
the movement on a monitor and issued new commands. This simulation was primarily to 
spot potential operational problems and debug the computer program prior to using a 
real industrial robot arm. 

A simple simulation experiment was conducted to compare the following two sets 
of equations, which can be used to control the robot arm in translational movement: 

1. Translational equations in the present paper (eqs. (A 6 ) to (A12) in conjunc- 

tion with eqs. (7), (20), and (23)) 

2. Regular resolved-rate equations (eqs. (A 6 ) to (A12)) 

« . 

Variations in the joint angles ©2 and 0 3 and the joint angle rates 02 and 0 3 
were compared for both extension and retraction movements of the robot arm. 

A second simulation experiment was conducted with the translational equations in 
the present paper to evaluate the effects of two different numerical integration 
techniques ( Adams-Bashforth second-order predictor and Euler), three different inte- 
gration step sizes (1/16, 1/32, and 1/64 sec), and combinations of the numerical 
integration techniques and step sizes. 


Simulated Arm Movement Through Elbow Singular Region 

The robot arm was initially positioned for the extension maneuver with the joint 
angle values 0 2 = -30° and 0 3 = -60°. Then, with a switch located on a real-time 
control console, a computer operator issued a translational velocity command 
V z6 = 40 mm/sec to extend the robot arm. 

• . 

The variations in joint angles 0 2 and 0 3 and their rates 02 and 0 3 for 
both control algorithms are plotted in figures 9 and 10 against time. 

Equations in present paper. - With respect to the elbow joint singularity 
( 0 3 = 0 °), the equations developed in the present paper are used when 0 3 is within 
±1° of full arm extension ( 0 3 = 0°); that is, 63 = 1 0 in equation ( 8 ). In 



figure 10, the final zero joint rates 0 2 = 0 and 0 3 = 0 stop the robot arm in the 
extended position (0 3 = 0° and 0 2 = -63° in fig. 9). Although the robot arm is 
fully extended, the operator maintains the input command V 26 = 40 mm/sec, which 
causes 0 2 in figure 9 to increase slightly with time. The reason for this con- 
tinued variation is that the arm stops extending at a small positive value of 0 3 
(the value depends on the integration step size). With the robot hand oriented with 
respect to the forearm as shown in figure 1, a small positive 0 3 with 
V Z 6 = 40 nun/sec produces a small pitch-down component (positive V p ) . By equa- 
tions (19) and (20), § 2 increases with V p . This small variation is not antici- 
pated to be a problem. By visual observation, the operator can issue commands to 
nullify any significant variations. Alternate approaches are to replace V,p > 0 

with V z g >0 in figure 5, or switch to cylindrical-type coordinates while the robot 
arm is fully extended. 

Resolved-rate equations .- After 3.5 sec in figure 10, the regular resolved-rate 
equations produce undesirable high frequency oscillations in 0- and 0,. The 
oscillation for 0 3 lies between the upper and lower limits of joint angle rate of 
±28.6 deg/sec. The oscillation in 0 2 is half that in 0 3 (eq. (17)) or approxi- 
mately ±15 deg/sec. These oscillations totally obscure the region between the oscil- 
lation boundaries. The joint angles 0 2 and 0 3 in figure 9 also show high 
frequency oscillations with amplitudes of about 1°. 

For the retraction maneuver, the robot arm was initially positioned with joint 
angle values of 0 2 = -60° and 0 3 = 0° for both the regular resolved-rate equa- 
tions and the equations of the present paper. As with the extension maneuver, a 
switch was used to issue a negative translational velocity command V z6 to retract 

the robot arm. No differences in joint angles or their rates were seen between the 
two control algorithms. 


Comparisons of Integration Schemes and Step Sizes 

The nominal integration scheme and step size used in the present paper are 
Adams -Bashforth second-order predictor and 1/32 sec, respectively. The question 
arose as to whether a simpler integration scheme and/or a different step size would 
have any effect on the system as defined for this study. The reason for this ques- 
tion was that another user might be constrained by computer capacities especially if 
real-time operation were required. Runs were conducted by using the translational 
control algorithms of the present paper to answer these questions. 

Comparisons are presented in figure 11 of joint angle movements and joint angle 
rates determined by using, first, the Adams-Bashf orth second-order predictor scheme 
and, then, the simpler Euler scheme for the extension maneuver. The step size for 
both calculations was 1/32 sec. The only difference seen between the two schemes 
occurs at the end of the extension maneuver. This difference appears to be caused by 
the arm extending to slightly different positions (0 3 ) because of the differences in 
the integration schemes. Thus, the user could take advantage of the simpler Euler 
integration scheme. 

To look at the effect of step size, the simpler Euler integration scheme was 
chosen for presentation in the present paper, since with the Adams-Bashf orth scheme, 
no meaningful differences were observed. Comparisons with different step sizes, 

1/16, 1/32, and 1/64 sec, are presented in figure 12. Little or no differences exist 
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between 1/32 and 1/64 sec. The difference which occurs for 1/16 sec in the extension 
maneuver is caused by the deadband around 0^# One other difference which occurs at 
the end of the extension maneuver for the step size of 1/16 sec is the slightly exag- 
gerated effect caused by the small pitch ( 02 ^ component which exists when 0^ is not 
exactly zero as was discussed earlier in this paper (fig. 7). It appears that a user 
could take advantage of using the Euler integration scheme and a step size of 
1/16 sec when using the system modelled in this paper. It is advisable, however, for 
the user to examine his situation carefully before making this decision. 


CONCLUDING REMARKS 

An operator commands the robot hand to move in a certain direction by commanding 
a velocity in that direction. Resolved-rate equations relate the operator* s commands 
to joint angle rates in the robot arm to move the hand. However, when the arm is 
fully extended, the equations become singular in the elbow joint variable. The pre- 
sent paper has presented a set of equations that enable control of the robot arm 
within the singular region. 

The resolved-rate equations are used, except when the elbow joint angle falls 
within a specified region (which includes the singular position) • In this region, 
the commanded translational velocity is resolved relative to a straight line passing 
through the shoulder and wrist of the robot arm. The elbow joint angle rate is then 
made proportional to the component lying along the line. The shoulder joint moves in 
the opposite direction to that of the elbow so that the hand retracts and extends 
along this line. Also, within this region, the shoulder joint pitches the robot arm 
in response to pitch command, and the waist joint rotates the robot arm about its 
base. 


The equations in this paper give the operator the option to bend the robot arm 
at the elbow in either the up or down direction. The operator simply extends the arm 
and backs it up again to automatically reverse the direction of the elbow bend. 

The equations which handle the elbow joint singularity and the equations which 
allow cylindrical-type movement of the robot arm were applied to move a graphically 
simulated robot arm. The desired motions were obtained, and the equations will be 
used in other experimental tests. 

At the elbow joint singularity, undesirable joint rate oscillations result from 
an implementation of the regular resolved-rate equations but not in the translational 
equations presented in the present paper. 

Finally, a simple experiment was conducted to compare two integration methods 
( Adams-Bashforth second-order predictor and Euler) and three integration step sizes 
(1/16, 1/32, and 1/64 sec). There were little or no differences seen in either set 
of tests. Therefore, it appears that if a user is constrained in the area of com- 
puter power, the simpler Euler integration scheme with a step size of 1/16 sec can be 
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used. However, it is advisable for the user to examine the situation carefully 
before making a decision. 


Langley Research Center 

National Aeronautics and Space Administration 
Hampton, VA 23665 
September 19, 1984 



APPENDIX A 


MATRICES L and J 1 

With respect to the robot hand axis system, an operator commands the transla- 
tional velocity V^, which is then transformed to the base coordinate system by 


V r 


L V 6 


(A1) 


With the robot arm parameters in reference 4 (table I), the equations to compute the 
elements of the transformation matrix L in reference 5 become 


= cos 64 cos cos Gg - sin 0^ sin 0^ 

Q 2 = sin 0 4 cos 0 5 cos 0 6 + cos 0 4 sin 0 6 
Q3 = -cos 64 cos sin 0^ - sin 64 cos 0^ 

Q4 = -sin 0 4 cos 00 sin 0 6 + cos 0 4 cos 0 6 
P 1 = -cos ( 0 2 + 0 3 ) 

P 2 = -sin( 0 2 + 0 2 ) (This represents a correction to ref. 5 .) 


T 1 = -sin 0^ 

T 9 = -cos 0 1 P 9 
T^ = cos 0^ 

T4 = -sin 0 1 P 2 

Ii^ ^ = -cos 0 ^ + t i 22 “ T 2 sin ^5 cos 

L 21 = -sin 0 -j + T 3^2 ” T 4 s i- n ®5 cos 0 ^ 

L 31 = P 2^1 + P 1 s ^ n ^5 cos ^6 


> (A 2 ) 


L 1 2 = -cos 0^ P1Q3 + T-jQ 4 + t 2 sin ^5 sin 
l 22 = -sin Q <\ p i Q3 + T3Q4 + T 4 sin 0 5 sin 0 6 

L 32 = P 2^3 " P 1 sin 0 5 sin 0 6 


= -cos 0<| P-j cos 04 sin 00 + sin ©4 sin 00 + T 2 cos 00 

L 23 = “ s ^ n 9 i p i cos 04 sin 05 + t 3 sin 04 sin 05 + T 4 cos 05 
L33 = P 2 cos 0 4 sin 00 - P-j cos 00 

J 


Rotations about the waist, shoulder, and elbow move the robot hand. This rela- 
tionship is expressed as 


->■ 





(A 3 ) 
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APPENDIX A 


where (from ref, 4) is (assume i ES = i WE ) 



-sin 0 i [sin 0 

+ sin(0 2 + 

0 3 )ll ES - C ° S 6 1 'SN 

COS [cos 

6 2 + cos(0 2 + e 3 ) ] i ES 

cos © 1 

cos(0 2 + 

V l ES 

J 1 - 

cos 0 1 [sin 0 2 

+ sin(0 2 + 

0 3 ,]l ES ‘ Sin «1 »SN 

sin 0 1 [cos 

0 2 + cos(e 2 + e 3 ) ] 1 ES 

sin 0 i| 

COS ( © 2 + 

V l ES 



0 


-[sin 0 2 

+ Sin(9 2 + S 3 )ll ES 

-sin(0 2 + 0 3 ) 

t es 


(A4) 

The determinant of is 

det ( J.J ) = [sin 0 2 + sin(0 2 + 0 3 )]sin 0 3 i^ g (A5) 

Equation (A3) can be solved for the joint angle rates as follows: 


(V 


6 1 = 


XO 5in 9 1 ' V Y0 
det (J ) 


COS Wes 


(A6) 


( V XO b 2 + V Y0 b 3 )sin(6 2 + V l ES + V Z Q [sin 9 2 + Sin(9 2 + 9 3 )]cOS(9 2 + V. 4s 
2 det ( ) 

(A7) 


{~ V X0 b 2 + V Y0 b 3 + V 20^ COS 0 2 + COS [ 0 2 + 9 3 ] 

det (J ) 


W> tsin 0 2 + Sin(0 2 + 0 3 )]l ES 


( A8 ) 


where 


b 1 = sin 0 2 cos(0 2 + 0 g ) - cos 0 2 sin(0 2 + 0 3 ) = -sin © 3 (A9) 
b 2 = cos © 2 [sin 0 2 + sin(0 2 + 0 3 > 3 ^ ES ~ sin © 1 t gN (A10) 
b 3 = sin 0 1 [sin 0 2 + sin(© 2 + 0 3 )]i Eg + cos i gN (All) 
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The only problem with these equations occurs when det (J\j ) = 0. In this paper, 
det ( ) is replaced by 

det ( J., ) = IQ' 5 sgn [det ( J., ) ] (A1 

whenever |det < j i > I < 10 ^ to circumvent computational problems. The sign of 
det ( J-j ) is considered positive when det (J-| ) =0. This paper presents a set of 
translational equations which are not affected by this condition. 



APPENDIX B 


THRUST, PITCH, AND ROTATE VELOCITY COMPONENTS OF ROBOT HAND 

Components of the commanded translational velocity V g of the robot hand 
(fig. 1) are related to its components in the axis system (X 2 ,Y 2 ,Z 2 ) as (ref. 5] 


where 


r 

CM 

X 

> 

i 


1 

o 

X 

> 

l 

V Y2 

1 0 
= R 2 r, 

o 

> 

_ V Z2 


o 

CS3 

> 

1 


-sin 0 2 

COS 

1 

R 2 " 

-cos 0 2 

-sin 


-?■ 


-cos 0 1 -sin 0 1 0 


-sin cos 0 


V X2 = Sin 6 2 (COS 6 1 V X0 + Sin 9 1 V Y0 } + COS 0 2 V Z0 


V Y2 = COS 0 2 (COS 0 1 V X0 + Sin 0 1 V Y0 ) ' Sin 0 2 V Z0 


V Z2 = “ Sin 0 1 V X0 + C ° S 6 1 V Y0 


Equations (B4) and (B5) represent corrections to reference 5. 


( B1 ) 


(B2 ) 

( B3 ) 

( B4 ) 
(B5) 
( B6 ) 
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The axis system ( X 2' Y 2' Z 2^ & oes not rnove with the forearm link ( i WE ) • The 
velocity components V T , V p , and V R indicated in figure 4 are given by 


— - 


- — 


- — 

V T 


cos a -sin a 0 


V X2 

V P 

= 

sin a cos a 0 


** 

K> 

V 


0 0 1 



R 




Z2 

— J 


— __ 


— 


(B7) 
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TABLE I.- HOMOGENEOUS TRANSFORMATION MATRIX PARAMETERS 


[From ref. 4] 


Joint, 

i 

a i, 

deg 

a i' 

in. 

r i' 

in. 

V 

deg 

0^ limits, 
deg 

1 

90 

0 

*1 

NO 

9 1 + 180 

+ 160 

2 

0 

$ l ES 

t l 

SN 

e 2 + 90 

+ 165 

3 

90 

0 

0 

e 3 + 90 

+ 135 

4 

90 

0 

*1 

WE 

o 

00 

r— 

+ 

<D 

+1 35 

5 

90 

0 

0 

9 5 + 180 

+ 105 

6 

0 

0 

#1 

HW 

06 

+270 


* 


l 


§t 



*1 

#1 


NO 

ES 

SN 

WE 

HW 


Length from neck to base = 26 in. (66.05 cm) 
Length from elbow to shoulder = 17 in. (43.18 cm) 
Length from shoulder to neck = 6 in. (15.24 cm) 
Length from wrist to elbow = 17 in. (43.18 cm) 
Length from hand to wrist = 6 in. (15.24 cm) 


(In kinematic equations, distance from hand axis system to wrist 
is assumed to be 0.) 





































(a) Zero elbow joint angle. 



(b) Small nonzero elbow joint angle when further extension of 

robot arm is stopped. 

Figure 7.- Drawing to indicate pitching motion of robot arm. 





(a) Joint angle 0 2 movement. 

Figure 9.- Joint angle movement for extension maneuver* 
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(a) Joint angle rate 0 2 . 


Figure 10.- Joint angle rate for extension maneuver. 
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O Regular resolved-rate equations 
□ Equations of present paper 



Figure 10.- Concluded. 










(c) Joint angle rate 0 2 * 
Figure 11.- Continued* 
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(d) Joint angle rate 63. 


Figure 12.- Concluded. 


39 



3. Recipient's Catalog No. 


5. Report Date 

December 1984 


6. Performing Organization Code 
506-54-63-01-00 


8. Performing Organization Report No. 

L- 1 5828 


10. Work Unit No. 


11. Contract or Grant No. 


13. Type of Report and Period Covered 

Technical Paper 


14. Sponsoring Agency Code 


1. Report No. 2. Government Accession No. 

NASA TP- 23 76 


4. Title and Subtitle 

TRANSLATIONAL CONTROL OF A GRAPHICALLY SIMULATED 
ROBOT ARM BY KINEMATIC RATE EQUATIONS THAT OVERCOME 
ELBOW JOINT SINGULARITY 


7. Author(s) 

L. Keith Barker, Jacob A. Houck, and Susan W. Carzoo 


9. Performing Organization Name and Address 

NASA Langley Research Center 
Hampton, VA 23665 


12. Sponsoring Agency Name and Address 

National Aeronautics and Space Administration 
Washington, DC 20546 


15. Supplementary Notes 

L. Keith Barker and Jacob A. Houck: Langley Research Center, Hampton, Virginia. 

Susan W. Carzoo: Sperry Corporation, Hampton, Virginia. 


16. Abstract 

An operator commands a robot hand to move in a certain direction relative to its own 
axis system by specifying a velocity in that direction. This velocity command is 
then resolved into individual joint rotational velocities in the robot arm to effect 
the motion. However, the usual resolved-rate equations become singular when the 
robot arm is straightened. To overcome this elbow joint singularity, equations are 
presented in this paper to allow continued translational control of the robot hand 
even though the robot arm is (or is nearly) fully extended. A feature of the 
equations near full arm extension is that an operator simply extends and retracts the 
robot arm to reverse the direction of the elbow bend (a difficult maneuver for the 
usual resolved-rate equations). Results show successful movement of a graphically 
simulated robot arm. 


17. Key Words (Suggested by Author (s) I 

Robot arm 
Manipulator 
Kinematic equations 
Resolved-rate control 


19. Security Classif. (of this report) 
Unclassified 


Singularities 
Tele operator 
Simulation 


18. Distribution Statement 

Unclassified - Unlimited 


Subject Category 63 


20. Security Classif. (of this page) 

21. No. of Paget 

Unclassified 

42 



For sale by the National Technical Information Service, Springfield, Virginia 22161 


NASA-langley, 1984 
















National Aeronautics and 
Space Administration 


THIRD-CLASS BULK RATE 


Washington, D.C. 
20546 

Official Business 

Penalty for Private Use, $300 


Postage and Fees Paid 
National Aeronautics and 
Space Administration 
NASA-451 





POSTMASTER: 


If Undeliverable (Section 158 
Postal Manual) Do Not Return 




